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ABSTRACT: This paper considers the problem of cartesian 
trajectory contra 1 of a closed-kinematic chain mec h a nis m robot 
manipulator, recently built at CUR to study the assembly of MSA 
hardware foe the future space station, lie study is performed by 
both computer simulation and experimentation for tracking of 
three different paths: a straight line, a sinusoid and a circle, 
linearisation and pole placement methods are employed to design 
controller gains. Results she w that the controllers are robust 
and there are good agreements between simulation and 
experimentation. They also show excellent tracking quality and 
small overshoots. 


1. DUSCOJCTKM 


lor the control of the NASA robot. In particular, we consider the 
cartesian trajectory control of a snail scale, manipulator with 2 
degrees of freedca, reseebling part of the ccaplete NASA robot. 
Controllers are designed through the linearization of the robot 
dynasties and pole placement methods, the tracking performance of 
the controller will then be studied by both simulation and 
experimentation for three different trajectories: a straight 
line, a sinusoid and a circle. This paper is structured as 
follows. First we present the hardwares of the manipulator trader 
study together with the development of its kinematic and dynamic 
equations. Then the linearization about an operating point is 
discussed in oonjwcticn with the controller design through the 
pole placement method, finally we report the results of ocaputer 
simulation and experimental study and make comparative 
evaluations. 


The control problem of robot manipulators can be considered 
to consist of two coherent subproblems: trajectory planning and 
trajectory control. Based on the coordinate system used in 
planning and controlling the robot hand trajectory, control 
schemes can be conveniently divided into two classes: joint 
space and cartesian space control schemes. In joint space control 
methods, the error actuating signal to the joint actuators is 
computed based on the error between the desired joint position 
and the actual joint position of the manipulator hand. On the 
other hand, the cartesian space-oriented methods use the error 
between the desired and actual cartesian position of the 
manipulator to confute the error actuating signal to the joint 
actuators (3] While enjoying the simplicity in trajectory 
planning, the joint space-oriented method suffers from the 
difficulty in determining link locations of the robot hand 
during motion, a task requiring to ensure obstacle avoidance 
along the trajectory [3]. Furthermore, joint coordinates are not 
suitable as a working coordinate system because the joint axes of 
most manipulators are not orthogonal and they do not separate 
position from orientation [10] . The cartesian space-oriented 
approach whose path planning requires intensive amputations for 
transformations between cartesian and joint coordinates in real 
time, has the advantage of assuring a certain degree of accuracy 
along the desired path and being more adaptable to the user. 

There has been numerous interest in developing cartesian 
space-oriented control schemes. Considering that paths are made 
UP by straight line segments, connected by smooth transition, 
Paul [10] and Taylor [15] proposed schemes that control the 
acceleration at the transition in order to achieve the desired 
cartesian path. Cartesian control of joint compliance 
manipulators was studied in [4]. The research in [6] and [17] 
shorn that cartesian acceleration and force can be controlled 
successfully. Recently a closed-kinematic chain mechanism robot 
was built at NASA (Goddard Space Flight Center) to study the 
robotic assembly of NASA hardware for the future space station. 
This paper presents part of the ongoing robotic research at CAIR 


2. TK KAKOTUTOR NHL 

The main parts of the robot manipulator under study are 
presented in Fig. 1. It is a closed-kinematic chain mechanism 
manipulator with two degrees of freedom. Two links of the 
manipulator are composed of two ball-screw actuators, driven by 
two dc motors and tang below a fixed platform by means of pin 
joints. TWo linear voltage differential transformers (LVDIj are 
mounted along the links to measure their lenghts. The other ends 
of the links are joined together by a pin joint on which a 
gripper is mounted. The gripper motion is expressed with respect 
to a reference x-y cartesian coordinate system attached to the 
fixed platform as seen. The cartesian variables x and y are 
related to the joint variables 1 .and L , the link lenghts by 
[»]: 



x-(l 1 2 -l 2 2 +d 2 )/(2d) 

(1) 

and 

y— [dd 2 ^ 2 - (l 1 2 -l 2 2 +d 2 ) 2 J 1/2 

(2) 


where d is the distance between the pin joints banging the 
actuators. 

The Lagrangian equation of motion of a robot manipulator is 
given by: 

F“M ( 1 ) "i+H ( 1 , 1 ) +G ( 1 ) (3) 

where F is a vector of input forces acting on the manipulator and 
1 is a vector of joint variables. K(l), N(l,i) and G(l) represent 
the mernent of inertia, the centrifugal and coriolis forces, and 
the gravity, respectively. Using Lagrangian approach, we derive 
the following equations of motions: 

r i“*i^i +lB i 1 » (l a - 1 i ) 7 <3q) ] U) 
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15) 


G^“ I -11^5 [2B^1^ 2 (lil B + l-2l B + 21^l2) ^ 

-mgl Jn [21 1 2 B 1 (l 1 +l 2 )-l2«I 2 ] I / (4dl 1 2 l 2 q) (6) 

Gj* I "iiijjISBjlj 2 tlilj n + l 2 l B| +'21^1 2 ) ~ ^ 

-mgl Jn [21 2 2 B 2 (l 1 +l 2 )-l 1 q 2 ] l/(4dl 1 l 2 2 q) (7) 

q«[4d 2 l 1 2 -(l 1 2 -l 2 2 +d 2 )] 1/2 (8) 

B 1 -l 2 2 -l 1 2 +d 2 ( 9 ) 

B 2 *=l 1 2 -l2 2+d2 {10) 

where a ^ is the Bass of the sewing part of the link, b is the 
total aass of the link, and l m represents the fixed length of the 
actuators. Both actuators are assuaed to be identical. In the 
derivation of the equations of notions the gripper is not 
included. 

The Jacobian relating joint variable velocities lj and £ to 
cartesian velocity variables x and y is given by 

lj/d -l 2 /d 

Ul 1 d 2 +l 1 l^-l^) / (qd> <l 2 d 2 +l 2 l£-l|) / (qd)|^ 

The trajectory control scheae employed in this paper is 
presented in Fig. 2 where cartesian position feedback is obtained 
through the forward kinematic transform [Eqs. (1) and (2)]. 
Actual velocity is obtained by differentiating the actual 
position, which is ioplemented by the data aquisiticn software. 
The errors of cartesian position and velocity are converted into 
corresponding joint variable errors by Beans of the inverse 
Jacobian aatrix . The joint variable errors will then serve as 
inputs to the PD controllers that in turn produce required forces 
for the actuators to track the robot gripper along a desired 
trajectory with a desired velocity profile. 


3. umumnai aw gomikujr desk* 

Since the dynamics of the aanipulator is highly nonlinear, 
linearization about a selected operating point should be employed 
in order to design effective PD controllers. According to the 
work in [12], the linearization consists of expanding Eqs. (4) 
and (5) about a selected operating point using Taylor series 
expansion, neglecting higher order tens and transforming the 
resulting expression into a linear state equation given by: 



z - Az + BF 

(12) 


W ■ Cz 

(13) 

where 

*-di i a *i V 1 

(14) 

and 

W-(li i 2 > t 

(15) 

The development ot A, B, and C can be found in 
Fig. 2 we can write 

[12]. Trm 


F-P(v 1 -H)+-D(v 2 -W) 

(16) 


where p ad D are aatrioes that contain parameters for the P 
controllers and D controllers, respectively and are given by 



The vector v, and v, are oranund vectors expressing the desired 
' joint variables md velocities, respectively. Substituting (16) 
into (12) aaplcying (13), after scae stipulation we obtain 


*- ( I+BDC ) -1 ( A-BPC ) z+ ( I+BDC ) -1 BQv ( j 8 ) 



and v -(vj v 2 ) T (20) 

From (18) it is obvious that the aatrices P and 0 should be 
selected such that the eigenvalues of (I+BDcPlA-HPC) are stable, 
which can be realized by several available aetbods of pole 
placement and softwares. Particularly the procedures proposed in 
[13] is reocamended. Here we assuae that the aatrix (I+BDC) is 
nonsingular. 


4. snuncM MD ECnRDBnSli STUD? 

In order to exaa the performance of the cartesian control 
scheae illustrated in fig. 2, we conducted both simulation and 
experimental study for tracking of three different trajectories: 
a straight line, a sinusoid and a circle. In the simulation 
study, the entire control scheme including the manipulator 
dynamics was simulated on an IBM/3CT using the System Simulation 
Language (SYSL). First PD controller gains were selected using 
the procedures discussed in Sect. 2 to ensure the system 
stability. Then the obtained gains were adjusted for each of the 
above three tracking cases until a satisfactory tracking was 
achieved. According to the simulation results, the gain 
adjustments were within 10% of the original gains obtained from 
the linearization and pole placement methods. In the 
experimental study, the robot manipulator was interfaced with 
the IBM asqwter through a data acquisition systa consisting of 
an IBM board, an adapter and a software called Labtech [7] . PD 
controllers, inverse Jacobian and the forward kinematic transform 
were implemented using Labtech. The gains obtained through the 
simulation study were applied to the real-time control of the 
robot manipulator. In the following we will present the above 
study results and sake cooperative evaluations: 


Hanerical Values: 


(a) Linearization about the heme position Hi « 83.80 cm, 
1 2 - 85.90 cal: 


0 0 0 1 
-45.66 17.97 0 0 

33.53 -48.34 0 0 
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(c) Robot Dynamics: m^ * .59 kg; a * 4.91 kg; d * .737 m. 


Tracking a straight iin»: 

In this study the robot is to track a desired straight line 
described by the equation y(t) « — x (t) - 42 ca with a desired 
velocity of 1.7cWs. Figure 3 presents the simulation and . 
experimental results to this case. The simulated motion follows 
the target path very closely with a maxim* deviation of ta. 
Experimental results show that the robot actually follows the 
desired path with an excellent tracking quality with some 
disturbances at the starting position. After reaching the steady 
state, the robot trades the desired path very closely with a 
maxiaui deviation of 3ma. The simulation and actual velocities in 
x and y directions are presented in Figures 4 and 5, 
respectively. As seen from these figures, both simulation and 
actual velocities lag behind the desired one. The simulation and 
actual velocities stay constantly at about 76% and 31% of the 
desired one, respectively. 

Tracking a sinusoid : 

The simulation and experimental results for tracking a 
sinusoidal trajectory described by the equation y * 2.5sin(2x-50) 
-82.5 cm with a desired constant velocity of 1.7 cm/s are shewed 
in Figure 6. The simulation notion follows the desired trajectory 
very closely with a constant deviation of 3em. Actual motion 
tows good tracking quality with some disturbances during the 
transient state. 


Tracking a circular path : 

In case we study the performance of the robot in 
tracking a circular trajectory described by the equation (x- 
13.5) 2 +(y+33) 2 »14 with a desired constant velocity of 1.7cn/s. 
Simulation motion agrees with the desired trajectory very closely 
with sene insignificant shifting. Experimental results shear that 
the actual motion of the robot resembles a circular path that is 
shifted to the left (horizontally) of the desired trajectory and 
is ocapressed vertically. The horizontal shifting and vertical 
oppression are about 5am and 3am, respectively. 


Evaluations and discussions : 

The existence of the tracking errors in the above study 
cases can be clarified by the following reasons: 

(a) The employed software and the computer are not capable 
of performing fast ooputatiens and hitfi sapling rates. Because 
the data acquisition system has been using a sampling rate of 3 
saples/sec, the feedback information provided by the position 
sensors (LVDT) cannot be updated quickly enough for the 
controller to act on the actuators. Thus the actual position of 
the robot cannot be pdated timely, causing motion overshoots. 

The tracking quality can be iproved tremendously if a data 


acquisition system with faster oeputation capability and lazier 
wplinp rata is eployed. 

(b) As expected from most industrial and educational 
robots, our robot also suffers from some problems in machine 
design such as vibration, backlash, nonidentical actuators, and 
joint friction. These problems create tracking errors and can be 
remedied by improving the machine design or applying a more 
a dv a n c ed control scheme such as adaptive control. 


5. corn new 

In this paper we have considered the problem of cartesian 
trajectory control of a closed-kinematic chain mechanism robot 
manipulator with two degrees of freedom. Linearization and pole 
placement methods were employed to design the PD controller 
gains. The performance of the control scheme was examined by both 
simulation and experimentation. Study results showed good 
a g r e e m e nts between simulation and experimentation. They also 
towed that appropriate adjustments of controller gains designed 
from a linearized model of a robot manipulator enables one to 
design effective controllers for this manipulator. Since the 
linearized model is only valid in the neighborhood of a selected 
operating point, the tracking can be iaproved if there exists a 
scheme to update the controller gains by updating the linearized 
model as the manipulator moves along the path. Current active 
research at CAIF is focused on the analysis and implementation of 
k> adaptive control scheme to the above robot manipulator. 
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Fig. 1 : The closed-kinematic chain 
mechanism robot manipulator 



Fig. 4 ; Horizontal velocity for the 
straight line case 
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